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Method and device for identification of the parameters of an electro-mechanical system 



he present invention relates to a method for identification of the parameters of 
an electro-mechanical system, in particular an electro-mechanical servo system, comprising a 
mass actuated by a force. Further, the present invention relates to a method for autotuning a 
controller of an electro-mechanical system and a method for controlling such an electro- 

5 mechanical system. Still further, the invention relates to corresponding devices, in particular 
a device for identification of the parameters of an electro-mechanical system, to an autotuner 
and to a controller, as well as to an electro-mechanical system itself. Finally, the present 
invention relates to a computer program for implementing said methods on a computer. 

A numerical control unit for controlling the position of a movable part, such as 

10 a machine table, in response to input machining information is known from US 5,159,254. 
The unit employs a servo control loop that can measure the values of the position, velocity, 
acceleration and motor current for the movable part at predetermined times. Using such 
measured values and, on the basis of a representative spring mass system model, values of 
inertia, mass, viscous friction and sliding friction can be calculated and used for 

15 automatically optimising the gain and offset parameters applicable to control of the machine. 

Usually, parameter identification of an electro-mechanical system and 
controller tuning are performed by either an expert who needs to perform measurements by 
using special equipment, which is even impossible for highly integrated digital servo loops, 
or by a non-expert who performs a trial and error procedure which often does not result in an 

20 optimised performance. It is therefore an object of the present invention to provide a method 
for identification of the parameters of an electro-mechanical system as well as methods for 
autotuning the controller of such an electro-mechanical system and a method for controlling 
the system which do not require any tuning expertise and special measurement equipment 
and which allow system identification and autotuning to be performed within a very short 

25 time, i.e. which only require several seconds or minutes so that a user can save a lot of time. 
Further, corresponding devices, an electro-mechanical systems and a computer program for 
implementing said methods shall be provided. 

The object is achieved by a method for system identification as claimed in 
claim 1 comprising the steps of: 
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a) applying a constant force to said electro-mechanical system for a predetermined time 
period, said force having an amplitude at a sub-friction level, 

b) stopping the mass by applying a negative force, 

c) iterating steps a) and b) by increasing the amplitude of the constant force applied in step a) 
in each iteration until the velocity of said mass is monotonously increasing during application 
of said constant force, 

d) estimating mass and friction of the electro-mechanical system from the measured 
movement of the mass, 

e) performing steps a) and b) at least for another two times by further increasing the 
amplitude of the constant force applied in step a) wherein the amplitude is increased in each 
iteration to at most a maximum level at which the electro-mechanical system does not exceed 
the boundaries of the electro-mechanical system, and 

f) estimating mass, friction and damping of the electro-mechanical system from the measured 
movement of the mass. 

The invention is based on the idea to obtain a smooth movement of the 
electro-mechanical system as response to the application of a force to the electro-mechanical 
system during which the system remains in the allowable moving range. The smooth 
movement is obtained by setting the amplitude and the time period of the applied force 
carefully. If the predetermined time period is too short the influence of dynamics and virtual 
play on the estimators will be significant, virtual play meaning play that is commonly caused 
by a combination of friction and flexibility with the consequence the the actuator may move 
and load does not. If the predetermined time period is too long it may be impossible to 
remain within the allowable moving range or the maximum velocity may be exceeded. 

The force amplitude is found by an iterative procedure. Starting at sub-friction 
level the amplitude is raised in small steps until it is detected that the velocity is 
monotonously increasing dining application of the constant force. At this point initial 
estimates are generated which are used for predicting the displacements of the subsequent 
steps. 

In the subsequent steps the force amplitude is raised at least for another two 
times, in particular with x% and 2x%, respectively, wherein x is chosen such that the 
predicted displacement is smaller than the allowable displacement. The responses to the 
application of these forces are used for identifying friction, mass and damping. 

It shall be noted that the present invention is not limited to translating systems, 
but can be applied to rotating electro-mechanical systems with equal success. Thus, the term 
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"mass" shall be broadly understood as including an inertia (i.e. a rotational mass), and the 
term force shall be broadly understood as including a torque. The present invention is mainly 
applied in electro-mechanical servo systems which are often referred to as double integrator 
systems, but can also be applied in a velocity control loop (single integrator system) or other 
electro-mechanical systems. 

Preferably, the initial friction is estimated based on the ratio between the time 
required for acceleration and the time required for stopping the mass. Further, a mass- 
friction-damping mathematical model of the electromechanical system is used for estimating 
mass, friction and damping of the system. Therein, friction estimation may consist of two 
estimates, i.e. one estimate for both directions of movement. Based on the differential 
equations of a mass-friction-damper system and using e.g. four position measurements during 
two consecutive movements, i.e. by a total of 8 measurements, all important parameters of 
the system can be estimated. 

In a preferred embodiment the force is applied as a block-wave signal having a 
constant maximum amplitude in step a), i.e. also in the iterations of step a). An alternative is 
a trapezoidal signal. Said signal may also have, after the positive force amplitude, a negative 
force amplitude in order to stop the mass according to step b). Amplitude and time period of 
the positive and negative part of the signal may be identical, however, can also be different. 

The required smooth movement is then obtained by setting the amplitude and 
the frequency of the block-wave signal carefully. A preferred range for the predetermined 
time period for application of the constant (positive) force is given in claim 5, i.e. in case of a 
block-wave signal the block-wave frequency is preferably fixed in a range between 0.1Hz 
and 50Hz, preferably at 2Hz. 

To determine the initial amplitude of the force to be applied in step a) the 
following further steps are provided in a preferred embodiment: 
aO) applying a force having a monotonously increasing amplitude until the mass starts 
moving and 

al) roughly estimating the friction of the electro-mechanical system and determining the 
direction of movement of the mass from the measured movement of the mass, 
which steps are performed prior to step a), in which the initial amplitude of the constant force 
is set lower, in particular 1 to 25% lower, than the friction estimated in step al). 
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Thus, the sub-friction level for the amplitude of the force can be determined. 
Preferably, the force is applied as a ramp signal in step aO). 

The estimation of the friction in step f) is completely independent of the 
damping and mass estimates. Preferably, the movements in step e) are in the same direction. 
5 However, if the direction dependency of friction is also preferred to be determined at least 
four movements are required, two with a positive force amplitude and two with a negative 
force amplitude as claimed in claim 9. 

The object of the invention is further solved by a method for autotuning a 
controller of an electro-mechanical system, wherein the parameters of said electro- 
1 0 mechanical system are identified by a method as described above, said parameters being used 
to determine the control parameters of a controller, in particular amplification including its 
sign, i.e. its polarity, integrator frequency, differentiator frequency and/or low-pass filter 
settings, so that the electro-mechanical system is operated stable in a low frequency area. 
According to the present invention autotuning can be performed easily without special 
1 5 expertise and measurement equipment within a very short time. 

Preferably the controller comprises a feedback control unit and a feedforward 
control unit. However, the feedforward control unit can also be omitted. 

An automatic bandwidth optimisation is proposed in claim 12. Based on the 
response of the system on a short set-point profile a criterion judges whether increasing the 
20 bandwidth was an improvement. Values of the bandwidth and the bandwidth increase are 

given in claim 14. A criterion forjudging whether an increase of the bandwidth has led to an 
improvement is preferably based on a root-mean-square (RMS) error of the difference 
between the measured movement and the set-point movement, in particular both during 
movement and during settling. This RMS error shows a clear minim um allowing to identify 
25 the optimum bandwidth. 

A method for controlling an electro-mechanical system according to the 
present invention is defined in claim 15. Therein, the parameters of the electro-mechanical 
system are identified as described above. These parameters are used to determine the control 
parameters of the controller such that the electro-mechanical system is operated stable by a 
30 method for autotuning as described above. 

A device for identification of the parameters of an electro-mechanical system 
comprising control means, sensor means and processing means is defined in claim 16. An 
autotuner according to the invention is defined in claim 17. A controller according to the 
invention is defined in claim 18. An electro-mechanical system according to the invention is 
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defined in claim 19. A computer program for implementing the methods according to the 
invention is defined in claim 20. 

The invention will now be explained in more detail with reference to the 
drawings in which: 

5 Fig. 1 shows a simple block diagram of a device for identification of the 

system parameters of an electro-mechanical servo system, 

Fig. 2 shows a flow chart of the method for parameter identification according 
to the invention, 

Figs. 3, 4 show different ramp excitation signals and the measured 
1 0 displacement and velocity, 

Fig. 5 shows the result of a ramp excitation signal with an experimental set-up, 

Fig. 6 shows a mass- friction-damping model, 

Fig. 7 shows a general electro-mechanical system, 

Fig. 8 shows worst-case errors on a load relative to displacement due to 

15 dynamics, 

Fig. 9 shows a motor controlled fourth order system with friction on the load, 
Fig. 10 shows typical block-wave responses of the motor as shown in Fig. 9, 
Fig. 1 1 shows a result of the first block-wave signal, 
Figs. 12-14 show the results of a block-wave signal having increased 

20 amplitudes, 

Fig. 15 shows a block diagram of a controller according to the present 

invention, 

Fig. 16 shows bode diagrams of the controller for various settings of the 
controller parameters, 
25 Fig. 17 shows Nichols plots of the controllers shown in Fig. 16, 

Fig. 18 shows bode diagrams of another controller, 
Fig. 19 shows Nichols plots of the controllers shown in Fig. 18, 
Fig. 20 shows abode diagram of an open-loop, 

Fig. 21 shows abode diagram of an open loop, zoomed on low frequencies, 
30 Fig. 22 shows a flow chart of the method for optimising the bandwidth of the 

controller, 

Fig. 23 illustrates the applied set-point during optimisation, 
Fig. 24 shows measured position, error and controller output for four different 
bandwidth frequencies and 
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Fig. 25 shows the RMS-criterion as a function of the applied bandwidth 

frequency. 



5 Fig. 1 shows an embodiment of a device for identification of the system 

parameters of an electro-mechanical servo system. Shown are control means 1 for controlling 
the application of a force to the electro-mechanical system 3, an actuator 2 for converting the 
electrical control output signal into a mechanical force to be applied on the mass of the 
electro-mechanical system 3, sensor means 4 for measuring the movement of the mass and 

1 0 processing means 5 for processing the measured movement and for estimating the desired 
system parameters mass, friction and damping. As explained above the electro-mechanical 
servo system 3 can be a translating system comprising a mass - shown are two masses mi, m 2 
connected by a spring s - actuated by a force F or a rotating system where a mass (inertia i) is 
actuated by a torque T. 

15 A particular embodiment of an electro-mechanical servo system under 

particular assumptions will be discussed in the following, which do, however, not limit the 
invention. 

First, the application range and the user requirements shall be discussed. 
The autotuner algorithm according to the present invention has been designed 
20 for electro-mechanical systems comprising a lumped mass, possibly with friction and 
damping, on which a force can be applied. Generally this mass is referred to as a double 
integrator. The lumped mass approximation is always only valid for a certain frequency 
range. The main assumption is that the system behaves like a lumped mass in between 1 and 
10 Hz. More specifically this means: 
25 • No bandwidth limiting resonance below 1 0 Hz. 

• No large phase shifts (>20°) between 1-10 Hz due to e.g. low-pass or delay 
characteristics of amplifiers or sensors. 

• System is not open loop unstable. 
Other important assumptions are: 

30 • System behaves linear except for friction, e.g. inhibits limited play and limited non-linear 
transmissions like cam-shafts etc. 

• Input for the controller is a position, measured with an incremental encoder system. 

For the autotuner algorithm it is assumed that the items below are known to 

the user: 
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• Translating or rotating systems: All systems of which the position measurement is 
performed on a rotating part are considered rotating systems. Systems with a motor 
driving a translating part by some transmission may be rotating if one measures on the 
motor but are defined translating when the measurement is on the translating load. 

• Encoder resolution in [incr/revolution] or [incr/m] 

• Maximum displacement [m] or [revolutions] 

• Maximum controller output [V] 

• Sample time [s] (already available in the controller) 

Even though some of the above items may be difficult to specify by the user, 
these inputs are expected to be essential for some autotuner steps as well as for reasons of 
safety. It may be possible to apply some smart procedures for detecting the encoder 
resolution or maximum displacement (e.g.: move system manually to maximum position), 
but yet no attention has been given in this direction. 

Further, in the following no attention is given to the initialisation of the 
system. For example the important questions of how to get the system within the allowable 
moving range and how to initialise the measurement system are not discussed in the 
following. It is assumed that when the autotuner algorithm is started the system is in the 
middle of the allowable moving range. 

Next, system parameters and variables and autotuner parameters shall be 

illustrated. 

The system parameters are parameters which are specific for the system to be 
tuned. These parameters may be specified by the user. In some cases they have default values 
as shown in the following table. 



Parameter 


unit 


Defau 
It 


Comment 


U_MAX 


m 


2.5 


Maximum controller output (user specified) 


X_MAX 


[incr 




Maximum displacement/rotation from the middle in 




] 




+ and - direction (user specified) 


T.SAMPLE 


[s] 


1 10* 3 


Sample time of the controller 



System variables are variables containing measurements and computation 
results as shown in the following table. 



Parameter 



Unit 



Comment 
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« 1 


incr] ] 


Position/rotation measurement 


:_out 


[V] 


Controller output 


r 


[s] 


(Discrete) time 


u_break-away 


m 


Controller output voltage at which a movement of 






BREAK-AWAY JJBVEL [incr] is detected 


polarity 


[-] 


Sign(c_out)/sign(x) 


ajblock 


m 


Amplitude of the block-wave excitation 


a_block_linear 


m 


Block-wave amplitude at which a linear movement 






was expected 


Vj 


[incr/s] 


i 1 j 1 

Average velocity between ' / 8*block_frequency and 






V 8*BL0CK_FREQUENCY, for i = 1,2,3,4 I 


x_linear 


[incr] 


Maximum displacement when applying 






a_block_linear 


ajblockl 


[V] 


Block-wave amplitude for first linear movement 


a_block2 


m 


Block-wave amplitude for second linear movement 


Kfc_safety 


m 


First friction estimate, used for computing 






x_expected2 


kdc_safety 


[incr/Vs 2 ] 


First k_dc estimate, used for computing x_expected2 


x_expected2 


[incr] 


Expected displacement when applying a_block2 


k_dc 


[incr/Vs 2 ] 


mass feedforward gain j 


kjv 


[Vs/incr] 


damping feedforward gain 


k_fc 


m 


Friction feedforward gain ( 


k_fa 


[Vs 2 /incr] 


mass feedforward gain 


fbw 


[Hz] 


Bandwidth frequency (0 dB crossing of the open 






loop) 


U 


[Hz] 


Breakpoint frequency integrator (^a) 


UP 


[Hz] 


Low-pass filter comer frequency 


k_p 


[-] 


Gain of proportional part of controller 


k_v 


[-] 


Gain of derivative part of controller j 


a_setpoint 


[incr/s ] 


Acceleration setpoint during optimisation 


vjsetpoint 


Liner/ s j 


1 AAovimnm xr*»1r\r»i"t"\r o<=>+r*OlTlt HlTPITlCT OT^flfni QJltlfYTI 

1 1VJ oXl TmU rP VclOCllY SOluv/JJJLt vLiuiug ujj iii-iiJ.oa.LHjii. i 


x_setpoint 


[incr] 


Maximum displacement during optimisation 


setpoint_optim 


[-] 


Object containing the setpoint to be used during 






optimisation 
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The autotuner parameters are parameters which characterise some actions of 
the autotuner. All these parameters and default values are motivated below: 



parameter 


unit 


Default 


Comment 


RAMP_SLOPE 


[V/s] 


0.2 


Slope of ramp function 


BREAK- 


[incr] 


100 


Movement level at which it is expected that 


AWAYLEVEL 






the controller output exceeds the stick-slip 








level 


ABREAK- 


- 


0.9 


Safety factor for break-away level 


AWAY_SAFET 
Y 






computation 


BLOCK_FREQU 


[Hz] 


2 


Frequency block-wave 


ENCY 








X_MIN_BLOCK 


[m] 


0.5 10" 3 


Displacement level below which the 


_T 






movement is considered non-linear, 








translating system 


XJMBSTJBLOCK 


[rev] 


0.17 


Rotation level below which the movement 


_R 






is considered non-linear, rotating system 


V_MDST_BLOCK 


[incr/s] 


liner. 


Velocity level below which the movement 






/t_samp 


is considered non-linear 


SETTLE_TIME_ 


M 


LB 

0.3 


Waiting time for the system to settle after 


BLOCK 






applying a one period block-wave 


DELTAJBLOCK 


m 


0.1 


Voltage with which the block-wave 








amplitude is increased when the movement 








was considered non linear. 


A TJT HPV CAP 




1.25 


Factor by which a_blockJinear is increased 


TORI 






for the first linear movement 


A_BLOCK_FAC 




1.5 


Factor by which a_blockJinear is increased 


TOR2 






for the second linear movement 


A_EXPECTED_ 




0.5 


Safety factor for computing expected 


SAFETY 






displacement when applying 








AJBLOCK_FACTOR2 
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INITIALBAND 


[Hz] 


5 


Initial bandwidth frequency 


WIDTH 








PHI_PM 


rt 


45 


Required phase margin (phase of the open 








loop at fb W ) 


BETA_LP 


L J 


0.65 


Relative damping of the low-pass filter 


INTEGRATORR 


[-] 


0.31 


Ratio between ft> w and fi 


ATIO 








LOWPASSRATI 
O 

T_SETPOINT_0 


[-] 


30 


Ratio between fj p and Jw 


M 


0.2 


Setpoint duration during optimisation 


PTIM 








SETTLE_TIME_ 


[s] 


0.3 


Waiting time alter applying a setpoint ior 


OPTIM 






optimisation. 


BW_1NCREASE 


[-] 


1.19 


Factor with which the handwidth is 


_FACTOR 






increased during one optimisation step 



The method for identification of the system parameters shall be explained in 
the following with reference to the flow chart of Fig. 2. All steps of the method will be 
illustrated further by simulated or experimental measurements shown in a number of further 
5 figures. 

First, ramp excitation of step SI shall be explained. 

The main goal of the first step SI is to obtain a starting voltage for the block- 
wave analysis. By applying a slowly increasing voltage and by tracing the position 
measurement the break-away voltage can be detected. The break-away voltage is a measure 

10 for stick-slip which, for dry-lubricated systems, will be close to the friction. For systems with 
a lot of play or virtual play the estimate may be poor. 

The two important autotuner parameters to be set are the slope of the ramp 
function and the break-away detection level, i.e. the displacement at which the system is 
expected to have exceeded the stick-slip level. 

1 5 The break-away level detection has to detect the stick-slip level. This may be 

hard as is shown in Fig. 3 and Fig. 4, which show the results after applying two different 
ramp functions to the system. Before reaching the actual stick-slip level (of 0.48 V is this 
example) a displacement of over 10 incr. is detected. This is easily observed in Fig. 3. Due to 
effects like play the actual system starts moving before reaching the actual stick-slip level. 
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Hie break-away detection level should be large enough to be able to deal with some play. On 
the other hand: if the break-away level detection is chosen too large an over-estimation of the 
break-away voltage may be obtained and this may result in a dangerous (too large) starting 

voltage of the block-wave analysis. 

In a particular practical embodiment a break-away level detection of 100 incr. 
was found to be efficient. As it is hard to obtain better information on theoretical grounds a 
break-away detection level of 100 incr. is proposed as an example. 

The importance of the slope of the ramp can also be explained with reference 
to Fig. 3 and Fig. 4. When applying a relatively steep slope (Fig. 3) the displacement 
increases relatively slow. Then it is hard to estimate stick-slip. A break-away level of 20 
increments or 100 increment gives completely different results. So the break-away voltage 
then depends merely on the break-away detection level. 

Fig. 4 presents the results after applying a ramp with as small slope: the 
measured displacement increases very rapidly after exceeding the stick-slip level. Now the 
15 computed break-away voltage will be less sensitive for the break-away-level. An obvious 
disadvantage of a small slope is the large duration of the first step of the autotuning 
algorithm. As an example a slope of 0.2 V/s is proposed. 

After applying the ramp function the system brakes on friction or damping (if 

present). 

20 Damping and friction levels are unknown at this point, so for safety the 

controller has to make sure the system brakes . This can be performed by reversing the 
controller output immediately after exceeding the break-away-level, and to hold this output 

until the velocity equals zero. 

Most systems will have some direction dependency in the stick-slip level and 
25 thus also in the break-away voltage. It is expected that the direction dependency is small and 
that an estimator for one direction is also a sufficient accurate estimator for the opposite 
direction. 

As a movement is performed the polarity can be set. With the assumption that 
the initial polarity in the controller is set to 1 the polarity can be computed by: 
30 POLAIUTY = SIGN(CouO*SIGN(X). 

The proposed algorithm has been applied to a 4 th order experimental set-up. 
The results are shown in Fig. 5. The experimental set-up is self-braking due to friction and 
stops almost immediately after reversing the sign of the controller output. It should be noted 
that the position measurement does not shoot away like in Fig. 4 even though both results 
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presented in Fig. 4 and Fig. 5 are measured on the same set-up. Apparently the non-linear 
behaviour at voltage levels close to friction is not very repeatable. 

Thus, as a result of the ramp excitation (SI) a first estimate of the fiction and 
direction of movement is obtained (S2) which are used in the following block-wave 

excitation (S3) to be explained next. 

For the autotuner algorithm it is assumed that the system to be tuned can be 
modelled as a mass-friction-damper system comprising a mass m 2 and a damper b as shown 
in Fig. 6. It was found that a friction-mass model having no damper was not sufficient to 

obtain the desired accuracy. 

The model can be described with the differential equations: 

(Equation 1) 

F + F f = mx + bx 

Assuming a constant force F is applied, solving the velocity with the assumption that x(0) =x 0 

and j(0) = v 0 gives the relation: 

F + F, b , (Equation2) 
w m m 

Now also x can be solved, with x(0) = xothe relation can be written as: 

m{F + F f ) ( -i. _ 1+ 0 + ^(l-^') + *o- (Equations) 
x{f >- ft 2 V m j b 

i -i. b Jh\\ 2 } and vo=0 and xtf=0 the relation simplifies to: 
If damping tends to zero ( e * t 2 ) 31111 v ° u 0 

F + F f 2 



20 



If x is measured at three time points after applying a constant force up to T, (and known 
initial conditions) b/m can be solved. The three time points are chosen as respectively T B , 
2T B , 4T B with T B = V 4 T t = % VaW (a fourth of one half period of the block-wave) 

b ln( 5^l ) (Equation 4) 

. _ _ \ x(4T B )-2x(,2T B ) + x(0) md f ^ damping breakpoint frequency (frequency 
B 'ix(2T B )-2x{T B ) + x{0) 

25 below which damping dominates the system). 
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After solving b / m it is possible to estimate K* (estimator for l /J if another movement with a 
different block-wave amplitude is performed: 

feCr,)-^^)^] (Equations) 
Kdc = ~JEt h 

The above equation can also be used for two movements with identical initial velocities. 
5 When the damping tends to zero the above formula simplifies to: 

r * o * a (r,)-x,(r,) 

Now also an estimate of the damping can be obtained (using equation 4): 

(Equation 6) 

b= B . • 

10 With the estimate of and the measured displacement during applying Auku it is possible 
to estimate coulomb friction (K/ e ) 

(^) ^gi) (Equation?) 

With help of Equation 5 it can be shown that the friction estimator can be written such that it 
is completely independent of the damping and mass estimates. It should be noted that when 

1 5 using the above equations 5 and 7 the movements as a result of Awocki and Aw„dk2 should be 
in the same direction. So, if the direction dependency of friction is also preferred to be 
computed 4 movements are required (Awocu, JW2 and -AtMki, -Aw«*a). Equation 7 can 
also be used when Kdc has been computed in a certain direction (two movements required) 
and the friction is computed for the opposite direction (at cost of error propagation of the 

20 and b / m estimate). Then three movements are required for computing friction in two directions 

(Abiocki, Abiock2 and -Abiocia)- 

For reasons of accuracy in the K fc estimate in both directions it is proposed to 

perform 4 movements (Aw«*i, **>v*yl and -Awodci, -Aw«*a) with the autotuner. 

For the analysis two responses are needed in one direction resulting from a 
25 constant force (S3). As also a braking mechanism has to be applied (S4) since the system is 
in open loop die most convenient wave form is a block-wave. 

For applying a block-wave two parameters have to be set carefully: 
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1) Block-wave frequency 

2) Block-wave amplitude 

The frequency of the block has to be that small that the system behaves in a 
(quasi) static way. Mostly, system dynamics can be represented by a fourth order system 
5 comprising two masses mi and m 2 connected by a spring and a damper as shown in Fig. 7. 

The first resonance of systems for which the autotuner is used is assumed to be 
above 10 Hz. After applying a step on the force it depends on the level of vibrations relative 
to Ihe absolute displacement (xj or x 2 ) for how long the dynamics significantly influences the 
position measurement. It can be shown that the maximum error (defined as position 
1 0 difference between motor and load position) equals e,„i =F/k,. Assuming that m,=m 2 the 
amplitude of the motor vibration is: c _i£ , withFthe input force and k the transmission 

stifihess. The position (x) of the motor can be approximated with: JC= x_f_^ using the 
assumption that the worst case resonance frequency equals 10 Hz (= JL — _ } — ) and 

V /«!,+»!» 

assuming that mi = m 2 = m the relation can be rewritten as: x a ± F t 2 • 

1 5 Now the relative error can be computed: 

e _ 1 (Equation 8) 

*~100;rV ' 

This relation means that for example after 0.25 s the error caused by 4 th order dynamics is 
smaller than 1.6 % of the resulting displacement, even when the system is undamped. The 
formula is illustrated with help of Fig. 8 which shows worst-case errors due to dynamics 
20 simulated for a 10Hz resonance 4 th order system with several values for damping, including 
0=0. 

It should be noted that the dynamics may significantly influence the response 
below 0.1 s. For systems with low-frequent dynamics it may be much better to choose other 
time points for analysis. For example: choose 4 equidistant time-points between 0.1 s and 
25 0.25 s for analysis. Worst case error in the position due to dynamics is less than 10 %. The 
initial velocity and position can easily be dealt with in the formulas for the estimators. 

When the motor mass m t is larger than the load mass m 2 the same relation, i.e. 
equation 8, can be used for a worst case estimate. However, when the mass of the load is 
larger than Ihe motor mass, influence of dynamics will be worse. Systems are usually 
30 designed to have a larger motor mass than load mass. 
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A second consideration for the duration of ft. block-wave is tot the motor 
^startresonadogmtovhtolptay.tttoduretlonoftooonstot force is targertonO.! 

virmalplay.TWsUexplainedmtheblock-waveampUtudesecnoobelow. 

Because of the influence of dynamics and the possibility to check tf the 
movement is outside to virtue! play i, is proposed te choose to block-wave frequency as 2 

Hz 

Now fteblock-waveampUtudeshaUbeascnssedltisnotpossMeto 

fcemitialblock-wave ampUmde as A.BMAK-AWAY.SAFETY • ubreak-away. As an 
example it is proposed to choose A_BREAK-AWAY_S AFETY as 0.9. 

For detecting a good movement two items are important: all parte are movmg 
(not just to motor), and to system behaves linear. 

A motion of all parte shall now be achieved. A complex system is a motor 

tbesoaessoftoplayCwifta^eywhichmaybesmanertoniOHzastoresonatmg 
massislsrgerwhe«toloadismstendsm 1 :form,-m 2 tonewre S onance ft e<penoy 

becomes 1M Hz) .This behavior is shown in Fig 10 showing a typical simulated 
reS p„nseoftomo«orofafoormorder S ystemwim«c«ionontoload,m,-m J anda 0Hz 

25 reaonance.onwbichonepenodofa^Hzblock-waveisappUed.Fig. 10a tows an undamped 
system and Fig. 10b shows a system with a relative damping of 0=0.95. 

Fig 10 shows the simulation results of applying a block-wave with an 

reaonatmgmovementmtovirtemplayc^betomtgmshedftomamovementofto 

complete system by considering to displacement or velocity signal carefully. For a free 
m ovmgmasstovelod V mcr^es(e.grofcr to Fig.l3)wmlstforamovem»tmtovntual 

p ,aytovelocity crosses zero wittrin to 0^5 durarion of to constant force. Tmsbebavrour 
also imposes a limit on to block-wave fluency as for a 0.1 duration of to constant force « 



20 



30 
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will be very hard to distinguish the movement in the play from a free mass movement (refer 
to Fig. 10). 

A reliable check if the movement is in the virtual play or outside the vntual 
play is possible on the velocity signal: if the movement is outside the virtual play the velocity 
5 increases in time (proportional with the time if damping is absent). The proposed check 1S to 
divide the constant force interval (V 2 T block = 0.25 [s]) in four equidistant sections and to 
compute the average velocity for these intervals. The section are defined by 0-T B -2T B -3T B - 
4T B withT B = % V**- 0-0625 s. Then the following check (S5) must be performed: 
V4>V 3 >V2>V,>0 
10 or 

x(4T B )-x(3r B ) : x(?T B )-x(2T B ) . xQT ! ) z x0T s ) > £gklz£^>Q. 

T B > T s T B T B 

Besides virtual play, actual play may exist in the system. If the system moves in the play the 
movement is like a free moving mass. This can not be distinguished from a movement 
outside the play. So this is very hard to deal with, and it can only be assumed that the actual 
15 play is small. 

Now, linearity shall be discussed. Effects like cogging or play may have 
significant influence for small movements and as a consequence the estimators may be poor. 
Cogging depends on the number of magnets/coils in a motor which for rotating motors 
typically varies between 6 and 12. The velocity check of step S5 may not be sufficient for 
20 detecting these non-linear effects. Adding a check on minimal displacement may prevent 
mistakes. For rotating systems a niinimal displacement of % rotation and for translating 
systems 0.5 mm will in most cases guarantee that the influence of cogging and play is small. 
Care must be taken that 0.5 mm or \ rotation is not close to the maximum displacement 
(close means 10 % of the maximum displacement); in mat case a minimal displacement of 
25 Vio of the maximum displacement is preferred. 

When the velocity check (S5) or the minimal displacement check have not 
been passed the amplitude of the block-wave must be increased (S6). The new amplitude 
must be that small that the system remains within its limits, so a small raising of the 
amplitude improves safety. However, when the steps are too small the block-wave analysis 
30 may consume quite some time. As an example, a step size of 0.1 V is proposed. 

When the checks (S5) have been passed for the first time a linear movement 
has been obtained. The corresponding block-wave amplitude (defined as A*«) is mostly just 
above the friction level. It was found in experiments that this first linear movement did not 
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result in the best estimators; however, a preliminary estimate for mass and Motion can be 
found (S7). 

Therefore, it is proposed to increase the block-wave amplitude in step S8 and 
to perform further block-wave excitations (S10) including a stop of the mass (Sll). It is 
5 expected generally that increasing the amplitude with 25 % and 50 % (at least two 
movements are required for analysis; a counter is applied in step S13) suffices: 

Ablockl - 1-25 A«near and Abbck2~ 1.5 Alinear- 

Numerous variations are possible for computing A b hcki and Abiocia- The best 
way is to verify the settings on several set-ups. Usually it is expected that it is possible to 
10 apply a force of 1 .5 times the friction force without exceeding maximum displacement levels. 

Care must be taken that the system boundaries (maximum displacement and 
U^) are not exceeded (S9). After applying A,™** it is possible to predict displacements. 
When assuming zero damping an initial estimate Kdoi of Kdc can be obtained by: 
K = ■ «<r.)-*ftp) , with Ti half a period of the block-wave (0.25 s for the proposed 2 Hz 

1 5 block-wave) and with £ TO = A Vnar 1T >~ T "° > ^ which T v=° is ^ ^ e -P oiat were &e tix™*™ of 

movement changes. Kdc is in the presence of damping an overestimation. 

Now it can be checked (S9) if the expected displacement is smaller than 50 % 
of the maximal displacement. The 50 % is a safety margin: the system starts braking at Ti but 
it may take up to time 2Tj before the system actually stops. The total displacement is then 
20 maximal 2 *(Ti). 



If the above inequities apply, the new block-waves with Abiocki and Abiocia can 
25 be applied. If not, other block-wave amplitudes have to be chosen (S12). Another constraint 
to be dealt with is the maximum controller output. 

The following dealing with constraints is proposed: 

• Block-wave amplitude constraints: 

If Abiocia is larger than Umax it is proposed to choose Abiocia = Umax and Abiocki = 

3 0 { Aiinear + Ablock2> /2 

• Displacement constraints: 

if Xexpectett is larger than Xnax it is proposed to choose 
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, U , £r ( 2 /t;ddt) 2x max . p (then Xexpected2 equals Xmax) and 

A. ,4.2, A rfc 
Afeiockl = { Aii near +Ablock2} /2. 

The ampUtude variation between Awocki and Awockz should be large enough to 
5 ensure a good resolution. For systems with little friction it may be wiser to choose Awocki and 
Abiock2 for example as respectively A Hn « B .+0.1U n »x and Aunear+O^Umax, instead of a certain 
percentage of Au nea r (approximately equal to friction). 

Finally (S14), good estimates for friction, mass and damping are obtained by 

equations 5-7 above. 

10 The above has been verified in an experimental set-up. First, a one-period 

block-wave with an ampUtude of 90 % of Ubreak-awayis applied. IW-away was established at 
0.48 V , which is just above the friction level of 0.46 V. The results of the first block-wave 
are shown graphically in Fig. 11. 

1 5 Forjudging linearity the (average) velocity for 4 equidistant intervals between 

0 and 0.25 s (constant force part) is computed. The velocities computed are respectively: vi= 
1475, v 2 =903, v 3 =419 and v 4 =1226 [incr/s]. As this is not an increasing sequence the 
movement is considered not linear (or in the virtual play) and the block-wave ampUtude is 
raised with 0.1 V (S6) and appUed again (S3). The new results are shown in Fig. 12. 

20 Again the (average) velocity is computed for 4 equidistant intervals between 0 

and 0.25 s: vi= 2459,,y 2 =5419, v 3 =71 13 and v 4 =7903 [incr/s]. An equivalent check would be 
to check if the displacement is monotonously increasing. Now the movement is judged to be 
linear, so A, inea r=0.532. Now an initial K fc andK^cis estimated (S7; for reasons of safety 
only): 

25 k fc =0-45 [V] (computed with ^=0.25 s and Tv=o=0.271 s). 
K Je = 5.6 10 6 [incr/Vs 2 ] 

Both estimates are reasonably accurate (actual values (0.48 and 4.8 10 6 ). It 
should be noted that K<jc is overestimated, which is typical for this estimation method. 

Now it is checked whether it is possible to raise Abiock with another 50 % (S8, 

30 S9). 

Ablock2 =1.5 Aiinear 

^{A^-K^K^e 10 3 [incr]. 
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As Xexpected is smaller than 50 % of the maximum displacement it is expected to 
be possible to raise the amplitude with 25% (Abiockt) and 50 % (Abiocia). First the block-wave 
with amplitude A b i 0 cki=H5 A b i OC kiinear is applied. The results are shown in Fig. 13. The 
maximum displacement (relative to the initial position) was measured to be 3.3 10 3 [incr]. 
5 Next, the block-wave with amplitude Abiock2 is applied, the results are shown 

in Fig. 14. The maximum displacement (relative to the initial position) was measured to be 
5.3 10 3 [incr] (x^^ted^ 10 3 proved to be a good safety estimate) 

Now all data needed for processing in one direction is acquired. The 
successive movements have been shown in Figs. 11-14. It should be noted that the position 
10 remains close to zero, even after 4 block-waves in one direction. 

The same experiments have also been performed in the opposite direction. 
The estimators, resulting from the equations presented above, are presented in 
the tables below: 



b/m estimation 


Positive direction 


T b 

0.062 [s] 
x(4T b ) 
4669 [incr] 
x(2T b ) 

1338 [incr] 

x(T b ) =362 

[incr] 


/„= 0.55 Hz 
(%> = fid <2ir ) 


Negative direction 


T b 

0.062 [s] 
x(4T b ) 
3538 [incr] 
x(2T b ) 
992 [incr] 

x(Tb) 
269 [incr] 


/ M = 0.41 Hz 



15 After averaging: / w = 0.48 Hz 
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Kdc estimation 


Positive direction 2 


Ci(Ti) 

3047 1 

>c 2 (Ti) 

4669 

Abiocki = 0.665 
Abiock2 = 0.798 


fCo C = 5.12 10 6 [incr/Vs 2 ] 


Negative direction 


xiCTO 
2206 
x 2 (Ti) 
3538 

Abiocki = -0.540 
Abiock2 = -0.648 


Kdc=4.83 10 6 [incr/Vs 2 ] 


After averaging: Kd C = 4.97 10 6 


Kf C estimation 


Positive direction 


xi(T,) 
3047 
x 2 (Ti) 
4669 

Abiocki = 0.665 
Abiock2 = 0.798 


K fc =0.412[V] 


Negative direction 


Xi(Ti) 
2206 
x 2 (Ti) 
3538 

Abiocki = -0.540 
Abiocia = -0.648 


K&=-0.371 [V] 



With the estimated K^ c also an estimate for the absolute damping can be 
5 computed (equation 6): The results for the positive and negative direction are respectively: b 
= 6.810- 7 and6=5.3 10' 7 

The results are very accurate, especially the most important estimator K^c 
estimate is very good. It was analysed how estimators are influenced by block-wave 
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amplitudes and if estimator errors in b / m propagate in the other estimators. It appeared that 
estimator errors in b / m hardly propagate. 

Next, controller tuning shall be explained. Fig. 15 shows a block diagram of a 
control loop including a controller 6 according to the present invention. The controller 6 
comprises an autotuner 61 for determining the control parameters of the controller based on 
the parameters of the electro-mechanical system 3 estimated as described above. Therefore, 
the autotuner 61 preferably comprises control means and processing means as shown in Fig. 
1 for estimating said system parameters. However, said control means and processing means 
may also be provided outside the autotuner 61 or outside the controller 6. The controller 6 
further comprises a trajectory generator 62 for generating a trajectory to be fed to a feedback 
control unit 63 and feedforward control unit 64. Further a signal generator 65 is provided for 
generating test signals. The elements 62 to 65 are controlled by the autotuner, and their 
outputs are switched on a common output by a switch 66 connected to the actuator 2. It 
should be noted that elements 62 and 65 could also be external devices. 

The most important feedback controller objective is to stabilise the system. In 
the autotuner this is realised by providing a phase lead at the bandwidth frequency. For 
controller tuning the Kp and K v part are used for providing the necessary amplification as 
well as for providing the phase lead. The phase lead has to be chosen large as it can not be 
excluded that there is phase loss in the system at the bandwidth frequency (e.g. phase lag in 
amplifier etc.) 

It is also possible, and in some cases desirable, to tune a 2 nd order low-pass 
filter and an integrator provided in the controller. The 2 nd order low-pass filter reduces the 
high frequent amplification which usually results in a smoother (less noisy) controller output. 
As a consequence the controller tuning seems more reliable to the user. Disadvantage is that 
it gives additional phase lag at the bandwidth frequency. This can be compensated for by 
increasing K v , but this results in less amplification at low frequencies (for a certain 
bandwidth and phase margin). The integrator may be used for 1) improving setpoint tracking 
by increased low-frequent gain, 2) improve settling by realising a zero-error in the presence 

of friction 3) increasing the settling speed by activating the integrator at the end of the 

setpoint. Disadvantage is that it also results in a phase lag at the bandwidth frequency (which 

also can be compensated by K v ). 

The term bandwidth" shall be understood as the (most low-frequent, 

descending) OdB crossing of the open loop frequency response function of x/Cm wherein x is 
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the output (position or rotation measurement) of the system and is the controller input 
signal. 

The controller (consisting of Kp, Kv, integrator and low-pass filter) can be 
approximated (continuous description) with the relation 

with Kp the proportional gain, K v the derivative gain, K* the integrator gain, fjp the 2 nd order 
low pass filter frequency and |8 lp the damping of the low pass filter. The controller has 
breakpoints at the frequencies:/, = Ki/(l^),fd^Kp/(K^) mdfip. 

With the controller a certain phase margin and a certain amplification at the 
10 bandwidth frequency shall be established. For computing the Kp and K v formulas are derived 
below. It is assumed that first the low-pass filter and optionally the integrator have been set 
(rules of thumb for the settings will be discussed later) and men to compute K p and K v to 
establish the desired phase margin and amplification. 

Due to the integrator a phase loss at the bandwidth frequency of 

15 ^)-««*{^) 

is obtained. The low pass filter results in an additional phase loss of 

Also the phase loss due to calculation delay can be computed 
v> c (A,)=AJ c 360[°] 

20 (so for a calculation delay of 0.1 ms this results in aphase loss of 0.18° at 5 Hz). 



From the system ( H _ „ ^ a damping estimate is obtained. The phase 

s 1 +2nf fd s 



provided by damping at the bandwidth frequency equals 

25 The phase lead to be given by the Kp-K v filter now equals 

9» C/w) = 9 m + 9l P (Av) + <Pi (Av) + <PcVbJ)- <P^n (AJ 
with 4> pm the desired phase margin. 

The Kp-Kv part of the controller provides a phase lead of 
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_ ( K.*tfJ \ (Equation^ 
p te =arctanl K V 

It should be noted that a maximum phase lead of 90° can be achieved by the 
Kp-Kv controller part. The KpK v part also has to realise a amplification such that the open 
loop gain equals one at the bandwidth frequency. 
5 The amplitude of the open loop at the bandwidth frequency can be computed 

from 

I *-(/*,) h 1 - 4K + TJJf (f^K^ (Equation 10) 

with: 

K = kdc 

(2#,„) 2 

Using equations 9 and 10 Kp and K v can be solved from the estimated Kd c , 
estimated damping, the desired phase margin and bandwidth frequency. 

From equation 9 it follows that: 
„ t MfPk^Kp (Equation 11) 

Substituting in equation 10 Kp can be solved: 

K = cosC^tv) (Equation 12) 

P K system (~fbw )^$> (fbw )-^mt egrator 

Now, with help of equation 1 1 K v can be solved as well: 

K _ «n(y to ) (Equation 13) 

20 So, when an integrator frequency, a low-pass frequency and low-pass damping 

have been set the K, and K v can be computed such that the feedback requirements (phase 
margin and bandwidth) are satisfied. It depends on the user requirements whether or not the 
integrator is advantageous. 
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Next, the proposed methods for tuning the controller respectively with and 
without integrator are explained. For both strategies the tuning aims at a 5 Hz bandwidth 
system with 45° phase margin 

First, controller tuning without integrator shall be discussed. 
5 For the autotuner it is hard to determine an optimal setting for the low-pass 

filter. When tuning manually, one usually hears (noise) and sees (noisy controller output) 
whether a low pass filter is required. The low-pas filter can also be used for dealing with 
dynamics when a frequency response function has been measured. None of the above 
information is available, so it is best to start with a best guess for the low pass filter. Roughly 
10 two 'best guesses are available' (although all in between values may be as good or better as 
well): 

1) minimise the high frequent gain with respect to the stability margins, 

2) minimise the effect of phase loss due to the low-pass filter and be satisfied with a 
'reasonable' high frequent amplification. 

15 Both strategies have been simulated. Fig. 16 shows the controller computed 

with equations 11 and 12 for several low-pass filter settings (%=«* fi P =3.8, fbwOO and fi p =30, 
fbwOD, for all controllers W=5Hz, phase margin = 45° and /3 lp =0.65). The resulting stability 
margins are visualised by applying the controller to a double integrator and presenting the 
Nichols plot in Fig. 17. From Fig. 16 it can be concluded that minimising the low-pass 
20 frequency results in a loss of the low-frequent amplification of almost 6 dB. As low-frequent 
amplification is usually one of the main controller objectives the strategy will not be optimal 
(unless a strong high frequent reduction is required). It seems more sensible to start with a 
'moderate' low pass filter frequency of e.g. fi p =30 £ w which hardly reduces the low-pass 
amplification but still results in ahigh frequent reduction of 15 dB. The damping of the low- 
25 pass filter has been set such that it closely matches the 9dB - 45° M-circle of the Nichols plot 
(|8ip=0.65). After setting the low-pass filter one can measure the noise on the controller output 
as a measure for undesired high frequent amplification. A measure for noise would be the 
RMS value of the high frequent (AC) component of the controller output when the system is 
in standstill. The high frequent component can be obtained by applying a high pass filter to 
30 the controller output: 

It is proposed to choose N as 20 samples as an example. 
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If Anoise exceeds a certain value (proposed is 0.5 V) the low-pass filter 
frequency is decreased to fip=3.8f bw and the KpK v settings are computed again and the 
controller is applied. 

An exemplary proposed tuning is: 
ft p =30f b w (decrease only if measure of noise exceeds maximum level) 
/3ip=0.65 

Kp andKy to match the desired gain and phase margin according to equation 
12 and equation 13. 

Next, controller tuning with integrator shall be discussed. 
As mentioned above adding the integrator improves disturbance rejection, 
tracking and provides a zero error in the presence of friction. It does not necessarily improve 
settling and it gives a phase lag at the bandwidth frequency which has to be compensated for 
by increasing the K v . When an integrator is desired it is usually set to maximal gain without 
violating the stability margins (phase margin in this case). For an integrator gain which 
1 5 corresponds with an integrator breakpoint frequency of 0.3 1 f bw the bode diagram is shown in 
Fig. 18. The Nichols plots are shown in Fig. 19. Again two settings of the low-pass filter 
have been applied; one 'moderate' which aims for maximal low-frequent amplification and 
one which aims for a minimal high frequent gain without violating the stability margins 
(f, p =3.8, f bw (I) and fi p =30, f bw (II); for comparison a pure K p -K v is shown as well; for all 
20 controllers f bw =5 Hz, phase margin = 45° and j3i p =0,65). Aiming for a minimal high frequent 
amplification results in a loss of low frequent amplification of almost 10 dB (compared to the 
controller with fi p ==30f bw ). This is only recommended when a lot of noise is present. The 
same criterion as proposed for controller tuning without integrator can be used for setting the 
low-pass filter. 
25 An exemplary proposed tuning is: 

f lp = 30f bw (decrease if measure of noise exceeds maximum level) 
j3i p = 0.65 

Ki=0.31fc w 27r (fi=0.31$> w ). 

Kp andK v to match the desired gain and phase margin according to equation 
30 12 and equation 13. 

With help of the estimates as described above the controller tuning has been 
computed as proposed above with low-pass filter and integrator and implemented in 
dSPACE. The measured open loop FRF of the actual system (with the dSPACE controller) 
and autotuner model (i.e. the mass-damper model and controller formula) are shown in Figs. 
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20 and 21 . The measured bandwidth was 4.9 Hz and the phase margin was 44° (so very close 
to the target of 5 Hz and 45°). It can be concluded that the estimated parameters and the 
proposed controller tuning results in the desired objectives. 

Now, an optimisation of the described method shall be explained with 
5 reference to the flow chart of Fig. 22. First the system parameters are estimated (S20) and the 
control parameters are determined by the method of autotuning (S21) as described above. 
The method of autotuning results in a first bandwidth at which a first movement is performed 
in step S22. This means that the controller is used to generate a short (e.g. for 0.2s) trajectory 
which the system is forced to follow using feedback control and friction feedforward. 
10 Depending on the quality of the feedback tuning this results in a small or large error, i.e. a 
difference between trajectory and measure position. 

For performing a bandwidth optimisation it is proposed to increase the 
bandwidth in steps, i.e> to perform autotuning (S23) to obtain an increased bandwidth. After 
every step of autotuning (S23) a movement is performed (S24) and the autotuner decides on a 
15 criterion whether increasing the bandwidth (or actually the expected bandwidth) was an 

improvement (S25). Improvement means that the error, i.e. the difference between trajectory 
and measured position, during and after movement has become smaller. If there was an 
improvement the algorithm returns back to step S23 to further increase the bandwidth, while 
in the negative case the best bandwidth is selected (S26) and the algorithm terminates. 
20 Important parameters to be set for this step are: 

• Step size for increasing the bandwidth 

• Movement setpoint 

• Optimisation criterion 

For choosing the step size the items below are of importance: 
25 • avoid an excessive optimisation time 

• avoid stability problems: when increasing the bandwidth stability problems may occur. 
The step has to be that small that the risk of becoming unstable in one step is minimal. 

• resolution has to be acceptable for users. 

A double integrator system (-2 slope) implies that when increasing the 
30 bandwidth with a factor k the magnitude increases with fe 2 . A magnitude raising of 3 dB is 
usually acceptable (i.e. the system will not become unstable). A magnitude raising of 6 dB 
(or bandwidth frequency raising of V2 ) is already risky (starting from a relatively safe 
amplitude margin of 9 dB the amplitude margin may be reduced to 3 dB in one step, a 3 dB 
amplitude margin is very close to instability). By performing simulations or more 
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experiments it is possible to check how risky a raising of 6 dB actually is. These checks have 
not yet been performed and for that it is proposed to remain on the safe side and the rncrease 
the controller gain with 3 dB per step. So the bandwidth is increased in steps of Ml -1.19. 
Then in 1 8 steps a 1 00 Hz bandwidth system can be achieved starting from a 5 Hz bandwidth 
5 system. Whether or not the duration of the optimisation is acceptable depends on the setpomt 

duration which is discussed below. 

The movement setpoint and optimisation criterion are closely linked to each 
other. The representative movement at least has to deal with the issues: 
. The movement has to be large and fast enough to ensure that the system behaves linearly 
10 • The movement has to be small enough to remam within the limits 
• Force has to remain smaller than the maximum force 

Other movement characteristics depend on the chosen optimisation criterion. 
Basically two approaches are possible: 
1 Criterion based on settling behaviour. As the focus is on settling, a second order setpoint 
15 profile without constant velocity part will do. The most important characteristic is the 
acceleration duration. If for example the setpoint duration is 0.1 s, the typical frequency 
contents is at 10 Hz. In that case a 5 Hz bandwidth controller may perform better than a 
10 Hz bandwidth controller (due to the peak in the sensitivity curve) and the optimisation 
will stop in a local niinimum. The setpoint should be chosen such that is 'slower' than the 
20 bandwidth frequency: a good setpoint duration would be 0.2 s. Theory about setpoints in 
relation to bandwidth frequencies and dynamics is known as input-shaping. 
2. Criterion based on tracking. Here, a setpoint with a constant velocity part has to be 

created. The dynamics may significantly influence the constant velocity during 0.4 s. The 
dynamics also depend on the bandwidth frequency and the acceleration duration. For 
25 certain combinations of bandwidth frequency and acceleration duration the performance 
will be worse than for a lower bandwidth frequency. So one has to wait until the 
influence of dynamics is negligible (wait for 0.4 s). 

In experiments it was found that using the second approach it is very hard to 
avoid a local optimum. The second approach also takes more time because of the large 
30 constant velocity part. Experimentally good results were found using the first approach with 
a short setpoint duration in combination with the optimisation criterion as explained below. 
Now, feedforward/feedback during optimisation will be explained. 
The feedback tuning will be like explained above. All parameters (integrator 
and low-pass) have to be implemented during optimisation as they influence performance and 
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stability. Less clear is, if it is advantageous to activate the feedforward parameters during 
optimisation. The friction part of the feedforward is meant to compensate for non-linear 
behaviour and it ensures that the system starts moving at the beginning of the setpoint. But if, 
for example, the complete feedforward tuning is perfect and the system behaves like a mass- 
5 friction-damper system there will be no difference in the response of a 5 Hz and 10 Hz 

bandwidth system. For this, the acceleration and damping part of the feedforward should not 
be activated during optimisation. This theory is also supported by experimental results. 

A reasonable value for the setpoint acceleration a^ maybe found by choosing 
the same acceleration as previously used (safely) during the block-wave analysis: 

10 a v - 04 Wodk2 - KjcWdc • 

The maximum velocity is chosen such that the total setpoint duration equals 

the desired setpoint duration (proposed: 0.2 s). 

V spMAX ^ setpoint a sp " 

The setpoint displacement can now also be computed: 

The setpoint is shown in Fig. 23. Only the magnitude of the setpoint is 
adjusted to the identified system characteristics, the shape will always be the same. No care 
has to be taken that the maximum displacement is exceeded as the acceleration magnitude is 
equal to the acceleration during application of A*** , only now the acceleration time is 
20 shorter. So also the maximum controller output will not be exceeded. The duration will be 
acceptable: one movement takes 0.2 s, another 0.3 s will suffice for settling. So for each step 
0.5 s are required, within 18 steps (total time 9 s) a 100 Hz bandwidth can be achieved. 

Forjudging the performance the RMS value of the error during (1) settling or 
(2) during the setpoint or (3) during both setpoint and settling can be considered. It was found 
25 that the latter seems most reliable. (1) is not recommended as it is possible that the systems at 
the end of the setpoint stops on friction (after that is may take quite some time before the 
integrator manages to overcome friction). Using (2) may result in missing errors after the 
setpoint. It is proposed to use the combination of both. 

For the proposed movement other criteria can be applied as well for judging 

30 the performance, such as: 

the RMS of the error after the setpoint during 0.3s; 
the RMS of the error during the setpoint only (0.2s); 
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the RMS of the error during 0.5s; 

the RMS of the controller output during 0.5s. 

The proposed optimisation is as follows: Apply 2 nd order setpoint without 
constant velocity part with a duration of 0.2 [s] and an acceleration magnitude of Abbda-Kfc- 
Compute the RMS value of error during the 0.2 [s] setpoint and 0.3 [s] settling. 

In an experimental verification, first the 5 Hz feedback tuning is applied based 
on the results obtained from the block-wave analysis (see Fig. 20). The applied setpoint is 
shown in Fig. 23. Next, the movement is performed, first for a bandwidth of 5 Hz, next for a 
bandwidth of V2 5 Hz. After that is it is decided whether the bandwidth raising was an 
improvement. In case of an improvement the bandwidth is again increased with a factor V2 . 
In case of no improvement the optimisation is stopped and the previous controller assumed to 
optimal and is implemented again. Fig. 24a-d show the response of the system for several 
bandwidth frequencies (i.e. for 10Hz, 16.8Hz, 33.6Hz and 40Hz). 

The proposed error criterion as a function of the bandwidth frequency is 
shown in Fig. 25. Up to a bandwidth frequency of 33.6 Hz the criterion is decreasing (i.e. 
improvement). At 40 Hz the criterion detects a worsening of the performance, and it is 
decided to apply a bandwidth of 33.6 Hz and to stop the optimisation. 

Other optimisation criteria are computed and possible. However, the RMS 
error has been shown to be the best criterion. 

Another movement well worth examining is a movement as a result of a step 
on the position setpoint. Dealing with friction is the main challenge in this strategy. 

Another alternative strategy would be to perform a 'representative movement' 
and ask the user if he wants to increase the bandwidth. After increasing the bandwidth the 
movement is repeated and the results are shown graphically. 

Even with small steps in the bandwidth raising there is still a risk of becoming 
unstable in one optimisation step (e.g. the presence of badly damped resonances). It is 
recommended to apply a measure for instability (e.g. controller output), when instability is 
detected a switch to an old (stable) controller can be made. 

From the above the following can be concluded. 

The proposed autotuner algorithm performed very well on the experimental 
set-up. Within several seconds estimates are obtained for damping, friction and the mass. The 
estimator of the mass and friction were within 10 % accurate. The damping estimate was a 
little bit less accurate, but still within 20 % of its actual value. By means of analysis and 
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simulation of dynamics and other common system characteristics like play, virtual play and 
stick slip it has also been made likely that the autotuner will perform well on other set-ups. 

It proved to be important to estimate damping as well. For the experimental 
set-up estimator errors of over 25 % were made if damping was neglected. 

5 The autotuner method is different from other known methods. The main 

difference is that it was found that analysing the response of a block-wave excitation in open 
loop leads to more accurate results than could be obtained from a closed-loop sine excitation 
and closed loop feedforward parameter estimation. Moreover, a block-wave analysis is very 
efficient. From four movements, which only take 0.5 s each, all important parameters can be 

10 estimated. 

For the feedback controller, tuning formulas are proposed which compute Kp 
and K v settings which provide the correct phase lead and amplification, given the mass and 
damping estimate, integrator frequency and low-pass filter settings. There are no settings 
which are optimal for all systems. Generally it is recommended to use the low-pass filter only 

1 5 if noise is present on the controller output. A rule of thumb (based on maximum low-frequent 
gain) is proposed for the integrator setting. 

An automatic bandwidth optimisation is proposed. The optimisation 
performed well on the experimental set-up. Based on the response of the system on a short 
setpoint profile a criterion judges whether increasing the bandwidth was an improvement. 

20 The proposed criterion was selected as it was the only tested criterion which could avoid a 
local optimum during the optimisation process. 
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